plat: rcar: Pass DTB with DRAM layout from BL2 to next stages

Pass DTB containing DRAM layout from BL2 to BL33 via register x3, so
that the BL33 can simply consume it and get accurate DRAM layout info.
BL33 is in most usecases U-Boot.

Signed-off-by: Marek Vasut <[email protected]>

diff --git a/plat/renesas/rcar/bl2_plat_mem_params_desc.c b/plat/renesas/rcar/bl2_plat_mem_params_desc.c
index 112a1edcdddc36d875c6f16126f52a3bc933ab73..728eac622833a815a9c128b07abfc2e1f5b86dd6 100644 (file)
--- a/plat/renesas/rcar/bl2_plat_mem_params_desc.c
+++ b/plat/renesas/rcar/bl2_plat_mem_params_desc.c
@@ -8,6 +8,7 @@
 #include <desc_image_load.h>
 #include <platform.h>
 #include <platform_def.h>
+#include <xlat_tables_defs.h>
 
 #if (RCAR_BL33_EXECUTION_EL != 0) && (RCAR_BL33_EXECUTION_EL != 1)
 #error
@@ -19,6 +20,8 @@
 #define BL33_MODE MODE_EL2
 #endif
 
+extern uint64_t fdt_blob[PAGE_SIZE_4KB / sizeof(uint64_t)];
+
 static bl_mem_params_node_t bl2_mem_params_descs[] = {
        {
                .image_id = BL31_IMAGE_ID,
@@ -69,6 +72,7 @@ static bl_mem_params_node_t bl2_mem_params_descs[] = {
 #ifdef RCAR_BL33_ARG0
                .ep_info.args.arg0 = RCAR_BL33_ARG0,
 #endif
+               .ep_info.args.arg3 = (uintptr_t)fdt_blob,
                SET_STATIC_PARAM_HEAD(image_info, PARAM_EP, VERSION_2,
                        image_info_t, 0),
                .image_info.image_max_size =

diff --git a/plat/renesas/rcar/bl2_plat_setup.c b/plat/renesas/rcar/bl2_plat_setup.c
index 75b9b900a4c64447adbff6a19524ff420a33d8bb..dce8c5a5abb5344c1164fcbe58ce508762f258c9 100644 (file)
--- a/plat/renesas/rcar/bl2_plat_setup.c
+++ b/plat/renesas/rcar/bl2_plat_setup.c
@@ -10,10 +10,12 @@
 #include <bl1.h>
 #include <console.h>
 #include <debug.h>
+#include <libfdt.h>
 #include <mmio.h>
 #include <platform.h>
 #include <platform_def.h>
 #include <string.h>
+#include <xlat_tables_defs.h>
 
 #include "avs_driver.h"
 #include "boot_init_dram.h"
@@ -85,6 +87,32 @@ CASSERT((PARAMS_BASE + sizeof(bl2_to_bl31_params_mem_t) + 0x100)
 
 static meminfo_t bl2_tzram_layout __aligned(CACHE_WRITEBACK_GRANULE);
 
+/* FDT with DRAM configuration */
+uint64_t fdt_blob[PAGE_SIZE_4KB / sizeof(uint64_t)];
+static void *fdt = (void *)fdt_blob;
+
+static void unsigned_num_print(unsigned long long int unum, unsigned int radix,
+                               char *string)
+{
+       /* Just need enough space to store 64 bit decimal integer */
+       char num_buf[20];
+       int i = 0;
+       unsigned int rem;
+
+       do {
+               rem = unum % radix;
+               if (rem < 0xa)
+                       num_buf[i] = '0' + rem;
+               else
+                       num_buf[i] = 'a' + (rem - 0xa);
+               i++;
+               unum /= radix;
+       } while (unum > 0U);
+
+       while (--i >= 0)
+               *string++ = num_buf[i];
+}
+
 #if (RCAR_LOSSY_ENABLE == 1)
 typedef struct bl2_lossy_info {
        uint32_t magic;
@@ -302,8 +330,10 @@ meminfo_t *bl2_plat_sec_mem_layout(void)
 
 static void bl2_advertise_dram_entries(uint64_t dram_config[8])
 {
+       char nodename[32] = { 0 };
        uint64_t start, size;
-       int chan;
+       uint64_t fdtsize;
+       int ret, node, chan;
 
        for (chan = 0; chan < 4; chan++) {
                start = dram_config[2 * chan];
@@ -314,6 +344,54 @@ static void bl2_advertise_dram_entries(uint64_t dram_config[8])
                NOTICE("BL2: CH%d: %llx - %llx, %lld GiB\n",
                        chan, start, start + size - 1, size >> 30);
        }
+
+       /*
+        * We add the DT nodes in reverse order here. The fdt_add_subnode()
+        * adds the DT node before the first existing DT node, so we have
+        * to add them in reverse order to get nodes sorted by address in
+        * the resulting DT.
+        */
+       for (chan = 3; chan >= 0; chan--) {
+               start = dram_config[2 * chan];
+               size = dram_config[2 * chan + 1];
+               if (!size)
+                       continue;
+
+               /*
+                * Channel 0 is mapped in 32bit space and the first
+                * 128 MiB are reserved
+                */
+               if (chan == 0) {
+                       start = 0x48000000;
+                       size -= 0x8000000;
+               }
+
+               fdtsize = cpu_to_fdt64(size);
+
+               snprintf(nodename, sizeof(nodename), "memory@");
+               unsigned_num_print(start, 16, nodename + strlen(nodename));
+               node = ret = fdt_add_subnode(fdt, 0, nodename);
+               if (ret < 0)
+                       goto err;
+
+               ret = fdt_setprop_string(fdt, node, "device_type", "memory");
+               if (ret < 0)
+                       goto err;
+
+               ret = fdt_setprop_u64(fdt, node, "reg", start);
+               if (ret < 0)
+                       goto err;
+
+               ret = fdt_appendprop(fdt, node, "reg", &fdtsize,
+                                    sizeof(fdtsize));
+               if (ret < 0)
+                       goto err;
+       }
+
+       return;
+err:
+       NOTICE("BL2: Cannot add memory node to FDT (ret=%i)\n", ret);
+       panic();
 }
 
 static void bl2_advertise_dram_size(uint32_t product)
@@ -591,6 +669,13 @@ lcm_state:
                rcar_qos_init();
        }
 
+       /* Set up FDT */
+       ret = fdt_create_empty_tree(fdt, sizeof(fdt_blob));
+       if (ret) {
+               NOTICE("BL2: Cannot allocate FDT for U-Boot (ret=%i)\n", ret);
+               panic();
+       }
+
        /* Print DRAM layout */
        bl2_advertise_dram_size(product);
 
@@ -650,6 +735,9 @@ lcm_state:
                          LOSSY_FMT2, LOSSY_ENA_DIS2);
 #endif
 
+       fdt_pack(fdt);
+       NOTICE("BL2: FDT at %p\n", fdt);
+
        if (boot_dev == MODEMR_BOOT_DEV_EMMC_25X1 ||
            boot_dev == MODEMR_BOOT_DEV_EMMC_50X8)
                rcar_io_emmc_setup();

diff --git a/plat/renesas/rcar/platform.mk b/plat/renesas/rcar/platform.mk
index f7d6216a84061816797e2ebb021d53f3a1dc7d98..0cc746d129a71fadf8f32fed73c785640cca631d 100644 (file)
--- a/plat/renesas/rcar/platform.mk
+++ b/plat/renesas/rcar/platform.mk
@@ -303,6 +303,7 @@ ERRATA_A57_813419  := 1
 include drivers/staging/renesas/rcar/ddr/ddr.mk
 include drivers/staging/renesas/rcar/qos/qos.mk
 include drivers/staging/renesas/rcar/pfc/pfc.mk
+include lib/libfdt/libfdt.mk
 
 PLAT_INCLUDES  :=      -Iinclude/common/tbbr                   \
                        -Idrivers/staging/renesas/rcar/ddr      \
@@ -331,6 +332,7 @@ RCAR_GIC_SOURCES    :=      drivers/arm/gic/common/gic_common.c     \
 BL2_SOURCES    +=      ${RCAR_GIC_SOURCES}                             \
                        lib/cpus/aarch64/cortex_a53.S                   \
                        lib/cpus/aarch64/cortex_a57.S                   \
+                       ${LIBFDT_SRCS}                                  \
                        common/desc_image_load.c                        \
                        plat/renesas/rcar/aarch64/platform_common.c     \
                        plat/renesas/rcar/aarch64/plat_helpers.S        \